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Abstract — Nonlinear PID control systems for a quadrotor 
UAV are proposed to follow an attitude tracking command and a 
position tracking command. The control systems are developed 
directly on the special Euclidean group to avoid singularities of 
minimal attitude representations or ambiguity of quaternions. 
A new form of integral control terms is proposed to guarantee 
almost global asymptotic stability when there exist uncertainties 
in the quadrotor dynamics. A rigorous mathematical proof is 
given. Numerical example illustrating a complex maneuver, and 
a preliminary experimental result are provided. 

I. INTRODUCTION 

A quadrotor unmanned aerial vehicle (UAV) has been en- 
visaged for various applications such as surveillance, sensing 
or educational purposes, due to its ability to hover with sim- 
pler mechanical structures compared to helicopters. Several 
control systems have been developed based on backstepping, 
sliding mode controller, or adaptive neural network [1], [2], 
[3]. Aggressive maneuvers are also demonstrated at [4]. 
However, these are based on Euler angles. Therefore they 
involve complicated expressions for trigonometric functions, 
and they exhibit singularities which restrict their ability to 
achieve complex rotational maneuvers significantly. 

There are quadrotor control systems developed in terms of 
quaternions [5]. Quaternions do not have singularities but, as 
the three-sphere double-covers the special orthogonal group, 
one attitude may be represented by two antipodal points on 
the three-sphere. This ambiguity should be carefully resolved 
in quaternion-based attitude control systems, otherwise they 
may exhibit unwinding, where a rigid body unnecessarily 
rotates through a large angle even if the initial attitude error 
is small [6]. To avoid these, an additional mechanism to lift 
attitude onto the unit-quaternion space is introduced [7]. 

There are other limitations of quadrotor control systems 
such as complexities in controller structures or lack of 
stability proof. For example, tracking control of a quadrotor 
UAV has been considered in [8], [9], but the control system 
in [8] has a complex structure since it is based on a 
multiple-loop backstepping approach, and no stability proof 
is presented in [9]. Robust tracking control systems are 
studied in [10], [11], but the quadrotor dynamics is simplified 
by considering planar motion only [10], or by ignoring the 
rotational dynamics by timescale separation assumption [11]. 

Recently, the dynamics of a quadrotor UAV is glob- 
ally expressed on the special Euclidean group, SE(3), and 
nonlinear control systems are developed to track outputs 
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of several flight modes [12]. Several aggressive maneuvers 
of a quadrotor UAV are demonstrated based on a hybrid 
control architecture, and a nonlinear robust control system is 
also considered in [13]. As they are directly developed on 
the special EucUdean group, complexities, singularities, and 
ambiguities associated with minimal attitude representations 
or quaternions are completely avoided [14]. 

This paper is an extension of the prior works of the author 
in [12], [13]. It is assumed that there exist uncertainties on 
the translational dynamics and the rotational dynamics of a 
quadrotor UAV, and nonUnear PID controllers are proposed 
to follow an attitude tracking command and a position 
tracking command. Linear or nonlinear PID controllers have 
been widely used in various experimental settings for a 
quadrotor UAV, without careful stability analyses. This paper 
provides a new form of integral control terms that guarantees 
asymptotic convergence of tracking errors with uncertainties. 
The nonlinear robust tracking control system in [13] provides 
ultimate boundedness of tracking errors, and the control input 
may be prone to chattering if the required ultimate bound 
is smaller. Compared with [13], the control system in this 
paper provides stronger asymptotic stability, and there is 
no concern for discontinuities. The structure of the control 
system is also simplified such that the cross term of the 
angular velocity does not have to be cancelled. 

In short, the unique features of the control system pro- 
posed in this paper are as follows: (i) it is developed 
for the full six degrees of freedom dynamic model of a 
quadrotor UAV on SE(3), including the coupling between 
the translational dynamics and the rotational dynamics, (ii) a 
rigorous Lyapunov analysis is presented to establish stability 
properties without any timescale separation assumption, and 
(iii) it is guaranteed to be robust against unstructured uncer- 
tainties in both the translational dynamics and the rotational 
dynamics, (iv) in contrast to hybrid control systems [15], 
complicated reachability set analysis is not required to 
guarantee safe switching between different flight modes, as 
the region of attraction for each flight mode covers the 
configuration space almost globally. To the author's best 
knowledge, a rigorous mathematical analysis of nonlinear 
PID-like controllers of a quadrotor UAV with almost global 
asymptotic stability on SE(3) has been unprecedented. 

II. QUADROTOR DYNAMICS MODEL 

Consider a quadrotor UAV model illustrated in Figure [T] 
We choose an inertial reference frame {61,62,63} and a 
body-fixed frame {6i,fo2,&3}- The origin of the body-fixed 
frame is located at the center of mass of this vehicle. The 
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Fig. 1 . Quadrotor model 

first and the second axes of the body-fixed frame, bi, 62, lie 
in the plane defined by the centers of the four rotors. 

The configuration of this quadrotor UAV is defined by the 
location of the center of mass and the attitude with respect to 
the inertial frame. Therefore, the configuration manifold is 
the special Euclidean group SE(3), which is the semidirect 
product of M'^ and the special orthogonal group SO (3) = 
{R e M'^^3 I R^R = I, det R = 1}. 

The mass and the inertial matrix of a quadrotor UAV are 
denoted by to G M and J G M"^^'^. Its attitude, angular 
velocity, position, and velocity are defined by i? G S0(3), 
fi, X, w G M"^, respectively, where the rotation matrix R rep- 
resents the linear transformation of a vector from the body- 
fixed frame to the inertial frame and the angular velocity 
il is represented with respect to the body-fixed frame. The 
distance between the center of mass to the center of each 
rotor is d G M, and the i-th rotor generates a thrust fi and a 
reaction torque ti along — 63 for 1 < i < 4. The magnitude 
of the total thrust and the total moment in the body-fixed 
frame are denoted by /, M G M'^, respectively. 

The following conventions are assumed for the rotors and 
propellers, and the thrust and moment that they exert on the 
quadrotor UAV. We assume that the thrust of each propeller 
is directly controlled, and the direction of the thrust of each 
propeller is normal to the quadrotor plane. The first and 
third propellers are assumed to generate a thrust along the 
direction of —63 when rotating clockwise; the second and 
fourth propellers are assumed to generate a thrust along the 
same direction of —63 when rotating counterclockwise. Thus, 
the thrust magnitude is / = J2i=i fi' ^'^'^ ^^ i^ positive when 
the total thrust vector acts along —63, and it is negative when 
the total thrust vector acts along 63. By the definition of the 
rotation matrix R G S0(3), the total thrust vector is given by 
—JRej, G M.^ in the inertial frame. We also assume that the 
torque generated by each propeller is directly proportional 
to its thrust. Since it is assumed that the first and the third 
propellers rotate clockwise and the second and the fourth 
propellers rotate counterclockwise to generate a positive 
thrust along the direction of —63, the torque generated by 
the i-th propeller about 63 can be written as Ti = {—lycrffi 
for a fixed constant Ctj. All of these assumptions are fairly 
common in many quadrotor control systems [5], [16]. 

Under these assumptions, the thrust of each propeller 



/i 1/2 1/37/4 is directly converted into / and M, or vice 
versa. In this paper, the thrust magnitude / G M and the 
moment vector M G M'^ are viewed as control inputs. The 
equations of motion are given by 



X = V, 
mv = mge:i - fRe?. + ^x, 

R = Rn, 

.m + rix ,m^ m + Ar, 



(1) 

(2) 
(3) 
(4) 



where the hat map ^ : E"^ — ^ so (3) is defined by the condition 
that xy — X X y foT all x,y E R^. This identifies the 
Lie algebra so (3) with M.^ using the vector cross product 
in M.^. The inverse of the hat map is denoted by the vee 
map, V : so (3) — >■ M^. Unstructured, but fixed uncertainties 
in the translational dynamics and the rotational dynamics 
of a quadrotor UAV are denoted by A^. and An G M.^, 
respectively. 

Throughout this paper, X,n{A) and Xm{A) denote the 
minimum eigenvalue and the maximum eigenvalue of a 
square matrix A, respectively, and A„j and Am are shorthand 
for A,„ = Ato(J) and Aj\/ = Ajv/(J). The two-norm of a 
matrix A is denoted by \\A\\. 

III. ATTITUDE CONTROLLED FLIGHT MODE 

Since the quadrotor UAV has four inputs, it is possible to 
achieve asymptotic output tracking for at most four quadrotor 
UAV outputs. The quadrotor UAV has three translational 
and three rotational degrees of freedom; it is not possible 
to achieve asymptotic output tracking of both attitude and 
position of the quadrotor UAV. This motivates us to introduce 
two flight modes, namely (1) an attitude controlled flight 
mode, and (2) a position controlled flight mode. While a 
quadrotor UAV is underactuated, a complex flight maneuver 
can be defined by specifying a concatenation of flight modes 
together with conditions for switching between them. This 
will be further illustrated by a numerical example later In 
this section, an attitude controlled flight mode is considered. 

A. Attitude Tracking Errors 

Suppose that an smooth attitude command Rd{t) G SO (3) 
satisfying the following kinematic equation is given: 



Rd — Rd^d, 



(5) 



where ild{t) is the desired angular velocity, which is assumed 
to be uniformly bounded. We first define errors associated 
with the attitude dynamics as follows [17], [18]. 

Proposition 1: For a given tracking command {R^, ild), 
and the current attitude and angular velocity {R, il), we 
define an attitude error function ^ : SO (3) x SO (3) -^ M, an 
attitude error vector en G M.^, and an angular velocity error 
vector eji G 



^{R,Rd)^^til~R^R]., 
^R — -^{RdR^R Rd) , 

ea^n- R^Rd^d, 



(6) 

(7) 
(8) 



Then, the following properties hold: 
(i) VP is positive-definite about R = Rd- 
(ii) The left-trivialized derivative of 4* is given by 



(9) 



(iii) The critical points of $, where e^ = 0, are {Rd] U 

{i?dGxp(7rs), s e S^}. 
(iv) A lower bound of ^ is given as follows: 

\\\eR\\^ <-^{R.Rd), (10) 

(v) Let -0 be a positive constant that is strictly less than 2. 
If '^{R,Rd) < V < 2, then an upper bound of ^ is 
given by 



*(i?,i?d)< 



1 



Ffll 



2-?/;' 
(vi) The time-derivative of '^ and en. satisfies: 

* == e_R • ea, WgrW < \\en\\- 
Proof: See [18]. 



(11) 



(12) 



B. Attitude Tracking Controller 

We now introduce a nonlinear controller for the attitude 
controlled flight mode: 

M = -knCR ~knen~ kjei 

+ {R^RdndTJR^Rd^d + JR^Rd^d, (13) 



ei 



en(T) + C2e_R,(T)(ir, 



(14) 



where kn, ka, ki, C2 are positive constants. The control mo- 
ment is composed of proportional, derivative, and integral 
terms, augmented with additional terms to cancel out the 
angular acceleration caused by the desired angular velocity. 
One noticeable difference from the attitude control systems 
in [12], [13] is that the cross term at (Hll, namely ft x Jft does 
not have to be cancelled. This simplifies controller structures. 
Unlike common integral control terms where the attitude 
error is integrated only, here the angular velocity error is 



also integrated at ( 14 1. This unique term is required to show 



exponential stability in the presence of the disturbance Ar 



in the subsequent analysis. From ( 12 1, it essentially increases 
the proportional term. The corresponding effective controller 
gains for the proportional term and the integral term are 
given by kj^ + kj and C2fc/, respectively. We now state the 
result that the zero equilibrium of tracking errors {er, en) is 
exponentially stable. 

Proposition 2: (Attitude Controlled Flight Mode) Con- 



sider the control moment M defined in ( 13 1-( 14 1. For positive 
constants ku, k^, the constants C2, -B2 are chosen such that 



C2 < mm 



(2J-tr[J]/)||||r!d|| <B2, 
\/kR\m 4/cn 



(15) 
(16) 



Am ' ^kR\M + (fco + B2Y 

Then, the equilibrium of the zero attitude tracking errors 

(e_R,en,e/) — (0,0,^) is almost globally asymptotically 



stable with respect to e^ and e^ and the integral term e/ is 
globally uniformly bounded. It is also locally exponentially 
stable with respect to cr and ejj. 

Proof: See Appendix [A] ■ 

While these results are developed for the attitude dynamics 
of a quadrotor UAV, they can be applied to the attitude 
dynamics of any rigid body. Nonlinear PID-like controllers 
have been developed for attitude stabilization in terms of 
modified Rodriguez parameters [20] and quaternions [21], 
and for attitude tracking in terms of Euler-angles [22], The 
proposed tracking control system is developed on S0(3), 
therefore it avoids singularities of Euler-angles and Ro- 
driguez parameters, as well as unwinding of quaternions. 

Asymptotic tracking of the quadrotor attitude does not 
require specification of the thrust magnitude. As an auxil- 
iary problem, the thrust magnitude can be chosen in many 
different ways to achieve an additional translational motion 
objective. For example, it can be used to asymptotically 
track a quadrotor altitude command [23]. Since the trans- 
lational motion of the quadrotor UAV can only be partially 
controlled; this flight mode is most suitable for short time 
periods where an attitude maneuver is to be completed. 

IV. POSITION CONTROLLED FLIGHT MODE 

We now introduce a nonhnear controller for the position 
controlled flight mode. 

A. Position Tracking Errors 

Suppose that an arbitrary smooth position tracking com- 
mand Xd{t) E M.^ is given. The position tracking errors for 
the position and the velocity are given by: 



X Xd^ 



Xd- 



(17) 



Similar with (14i, an integral control term for the position 



tracking controller is defined as 



/' 

Jo 



e^{T) +Cie^{T)dT, 



(18) 



for a positive constant ci specified later. 

For a positive constant cr e M, a saturation function satg- : 
M -^ [— cr, a] is introduced as 

a if y > cr 
sato-(y) ^ {y if - cr < y < cr ■ 
-cr if y < —cr 

If the input is a vector y G M", then the above saturation 
function is applied element by element to define a saturation 
function satcr(j/) : M" — >■ [—a, a]" for a vector. 

In the position controlled tracking mode, the attitude dy- 
namics is controlled to follow the computed attitude Rc{t) G 
SO (3) and the computed angular velocity ilc{t) defined as 



Re ^ [bi^; bs^ X bi^; bsj, Ci^^rIR, 



see [19, Chapter 4] for the definition of partial stability 



(19) 



where 63^ e S^ is given by 

_ -kxBx - kyCy - kisatcrjej) - mgej, + mxd 

W-Kfix - Key - kisa.i„{ei) - mges + mxd\\ ' 

(20) 

for positive constants kx,ky,ki, a. The unit vector 61^ e S^ 
is selected to be orthogonal to 63^, thereby guaranteeing that 
Re € SO (3). It can be chosen to specify the desired heading 
direction, and the detailed procedure to select bic is described 
later at Section IIV-CI 

Following the prior definition of the attitude error and the 
angular velocity error, we define 

1 



||ex(0)|| <e. 



(28) 



eR ^ -{R'^ R - R' R,y , en = n-R'RA 



(21) 



and we also define the integral term of the attitude dynamics 
6/ as ( [l4j i. It is assumed that 

W-kxCx - kyCy - fcisata(ej) - mges + mxd\\ ^ 0, (22) 

and the commanded acceleration is uniformly bounded: 

II - mge^ + mxdW < Bi (23) 

for a given positive constant Bi. It is also assumed that an 
upper bound of the infinite norm of the uncertainty is known: 

II A, II 00 < 5x (24) 

for a given constant 5x- 

B. Position Tracking Controller 

The nonlinear controller for the position controlled flight 
mode, described by control expressions for the thrust mag- 
nitude and the moment vector, are: 

/ = {kxCx + kyCy + kiHaXcriei) + mgez - mxd) ■ Rea, 

(25) 

M = -kpieii - knen - kjei 

+ {R^Rcnc)'^JR^Rcnc + JR^RA- (26) 



The nonlinear controller given by equations (25 1, (26 1 



can be given a backstepping interpretation. The computed 
attitude Re given in equation ( [T9] l is selected so that the 
thrust axis —63 of the quadrotor UAV tracks the computed 
direction given by —63^ in (20 1, which is a direction of the 



for positive constants t/^i , Cx^^^ ■ Consider the control inputs 
/, M defined in (25 i-(26 1. For positive constants kx, ky, we 



choose positive constants ci,C2,kfi,kfi,ki,ki,a such that 



ci < nun ■ 



ha > 6x, 

Akxkyil-a)"^ 



fc2(l + a)2 + Amkxil - a) ' 




A™ (1^2) > 



||^12f 



(31) 



and (16 1 is satisfied, where a — ■y/-i/;i(2 — -01), and the 
matrices Wi, W^i2, W2 G M^^^ are given by 



W2 = 



'cikx{l-a) -^{1 + a) 
-^(1 + a) ky{l-a)-mci 

ci{V3ha + Bi) 6 
kiff -\- Bi + kxEx^^^ 

C2kR -f{kn + B2) 

~fikn + B2) kn-2c2\M 



(32) 
(33) 
(34) 



Then, the zero equilibrium of the tracking errors is exponen- 
tially stable with respect to 63;, e„, e/j, cq, and the integral 
terms ei,e/ are uniformly bounded. 

Proof: See Appendix [B| ■ 

Proposition[3] requires that the initial attitude error is less 
than 90° in ( |27| . Suppose that this is not satisfied, i.e. 1 < 
*(i?(0), iT!c(0)) < 2. We can still apply Proposition |2] which 
states that the attitude error is asymptotically decreases to 
zero for almost all cases, and it satisfies ( pTJ ) in a finite time. 
Therefore, by combining the results of Proposition l2] and 
[3] we can show attractiveness of the tracking errors when 
*(i?(0),i?,(0))<2. 

Proposition 4: (Position Controlled Flight Mode with a 
Larger Initial Attitude Error) Suppose that the initial condi- 
tions satisfy 



l<*(i?(0),i?c(0))<2, 

l|e^(0)||<e,._, 



(35) 
(36) 



thrust vector that achieves position tracking. The moment f ^ ^ r^ a tu t ^ ■ t f i\t a 

^ ^ = tor a constant e^:^^^^^. Consider the control mputs j,M de- 



expression ( 26 1 causes the attitude of the quadrotor UAV to 
asymptotically track Re and the thrust magnitude expression 
( [25] l achieves asymptotic position tracking. The saturation 
on the integral term is required to restrict the effects of the 
attitude tracking errors on the translational dynamics for the 
stability of the complete coupled system. 

The corresponding closed loop control system is described 
by equations ([T]i-(|4]i, using the controller expressions ( [25] l- 
(26 1. We now state the result that the zero equilibrium of 
tracking errors (e3;,e„, e^j, en) is exponentially stable. 

Proposition 3: (Position Controlled Flight Mode) Sup- 
pose that the initial conditions satisfy 



*(i?(0),ii!,(Q))<^i<l, 



(27) 



fined in (25 i-(26 1, where the control parameters satisfy (29 1- 
(31 1 for a positive constant i/)! < 1. Then the zero equilib- 
rium of the tracking errors is attractive, i.e., ex, Cy, en, en — >■ 
as t ^ cx). 

Proof: See Appendix [C] ■ 

Linear or nonlinear PID controllers have been widely 
used for a quadrotor UAV. But, they have been applied 
in an ad-hoc manner without stability analysis. This paper 
provides a new form of nonlinear PID controller on SE(3) 
that guarantees almost global attractiveness in the presence 
of uncertainties. Compared with nonlinear robust control 
system [13], this paper yields stronger asymptotic stability 
without concern for chattering. 



C. Direction of the First Body-Fixed Axis 

As described above, the construction of the orthogonal 
matrix R^ involves having its third column &3^ specified 



by (20 1, and its first column 5i^ is arbitrarily chosen to be 
orthogonal to the third column, which corresponds to a one- 
dimensional degree of choice. 

By choosing hi^ properly, we constrain the asymptotic 
direction of the first body-fixed axis. Here, we propose to 
specify the projection of the first body-fixed axis onto the 
plane normal to h^^. In particular, we choose a desired 
direction fei^ e S^, that is not parallel to 63^, and 61^ 
is selected as 61^ = Proj[6i^], where Proj[-] denotes the 
normalized projection onto the plane perpendicular to 63^. 
In this case, the first body-fixed axis does not converge to 
61^, but it converges to the projection of 5i^, i.e. 61 -^ bi^ — 
Proj[&i^] as i — )■ 00. This can be used to specify the heading 
direction of a quadrotor UAV in the horizontal plane [23]. 

V. NUMERICAL EXAMPLE 
The parameters of a quadrotor UAV are chosen as J = 



[0.43,0.43, L02]x 10-2 kgm2 



m 



0.755 kg, d = 0.169 m, 



Crf = 0.0132 m. Disturbances for the translational dynamics 
and the rotational dynamics are chosen as 

A^ = [-0.5, 0.2, 1]"^ N, Ar = [0.2, -0.1, -0.02]^ Nm. 

Controller parameters are selected as follows: k^ — 12.8, 
k^ = 4.22, ki = 1.28, k^ = 0.65, fco = 0.11, fc/ = 0.06, 
ci = 3.6, C2 = 0.8, cr = 1. 

Initially, the quadrotor UAV is at a hovering condition: 
a:(0) = v{0) = r2(0) = O3XI, and i?(0) = /3x3- The desired 
trajectory is a flipping maneuver where the quadrotor rotates 
about its second body-fixed axis by 360°, while changing 
the heading angle by 90° about the vertical 63 axis. This is a 
complex maneuver combining a nontrivial pitching maneuver 
with a yawing motion. It is achieved by concatenating the 
following two control modes: 
(i) Attitude tracking to rotate the quadrotor (t < 0.4) 

Rd{t) ~ exp(7rte3) exp(47rie2). 

(ii) Trajectory tracking to make it hover after completing 
the preceding rotation (0.4 < t < 4) 

Xd{t) = [0,0,Of, 61, = [0,1,0]^. 

Figure |2] illustrate simulation results without the integral 
control terms proposed in this paper There are steady state 
errors in attitude tracking and position tracking at Figures 



2(a) and 2(b) The proposed integral control terms eliminate 



the steady state error while exhibiting good tracking per- 
formances as shown at Figure l3] The resulting controlled 
maneuver of the quadrotor UAV is illustrated at Figure |4] 

In the prior results of generating nontrivial maneuvers of 
a quadrotor UAV, complicated reachability analyses are re- 
quired to guarantee safe transitions between multiple control 
systems [15]. In the proposed geometric nonlinear control 
system, there are only two controlled flight modes for posi- 
tion tracking and attitude tracking, and each controller has 
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Fig. 3. Flipping with integral terms (red,dotted:desired, blue,solid:actual) 



large region of attraction. Therefore, complex maneuvers can 
be easily generated in a unified way without need for time- 
consuming planning efforts, as illustrated by this numerical 
example. This is another unique contribution of this paper. 

VI. Preliminary Experimental Results 

Preliminary experimental results are provided for the at- 
titude tracking control of a hardware system illustrated at 
Figure [5] To test the attitude dynamics, it is attached to a 
spherical joint. As the center of rotation is below the center 
of gravity, there exists a destabilizing gravitational moment, 
and the resulting attitude dynamics is similar to an inverted 







Fig. 4. Snapshots of a flipping maneuver witli integral terms: the red axis 
denotes the direction of the first body-fixed axis. The quadrotor UAV rotates 
about the horizontal 62 axis by 360°, while rotating its first body-fixed axis 
about the vertical 63 axis by 90°. The trajectory of its mass center is denoted 
by blue, dotted lines. 




(a) Hardware configuration 
Fig. 5. Hardware development for a quadrotor UAV 



(b) Attitude control 
testbed 



rigid body pendulum. The control input at ( 1 3 1 is augmented 
with an additional term to eliminate the effects of the gravity. 
The desired attitude command is described by using 3- 
2-1 Euler angles, i.e. Rd{t) = Rd{4>{t),9{t),'4}{t)), where 
(j){t) = |sin(7ri), e{t) = | cos(7ri), ^^{t) = 0. This 
represents a combined rolling and pitching motion with a 
period of 2 seconds. The results of the experiment are illus- 
trated at Figure |6] This shows good tracking performances 
of the proposed control system in an experimental setting. 
Experiments for the position tracking is currenlty ongoing. 

Appendix 
A. Proof of Proposition [2] 

We first find the error dynamics for e^j, en, and define 
a Lyapunov function. Then, we find conditions on control 
parameters to guarantee the boundedness of tracking errors. 

Using ([3]l, (HI, p6| , the time-derivative of Jen can be 
written as 



Jen = { Jeo + rfj^eo - kRCR - kncn - kjei 



(37) 



where d = (2J - tT[J]I)R^Rd^d e M^. The important 
property is that the first term of the right hand side is normal 
to eo, and it simplifies the subsequent Lyapunov analysis. 
Define a Lyapunov function V2 be 



V2 = -en ■ Jen + kn *(i?, Rd) + c2eR ■ Jen 



(38) 
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Fig. 6. Attitude tracking experiment (red,dotted:desired, blue, solid: actual) 



From ( 10 1, (111, the Lyapunov function V2 is bounded as 



Z2M2lZ2 + ^\\ei 



^f,v. 



<zjM222:2 + y||e/ 



(39) 



where Z2 == [||efl||, 
Ml 2, M22 are given by 



\en\\V e 



ki " ' 
^, and the matrices 



M 



21 



kR 
'C2XM 



-C2XM 

Am 



, Af; 



22 



r 2kr 



2-1A2 



C2A 



C2A 



M 



M 



(40) 



From (111, the upper-bound of ( 39 1 is satisfied in the 
following domain: 

D2 = {{R, n) e S0(3) X M^ I *(i?, Rd) < V2 < 2}. (41) 

From (fT2|, (J37]i, the time derivative of V2 along the 
solution of the controlled system is given by 

V2 = -fco||en|p - en • (fc/e/ - A^) + 026^ • Jen 
+ C2ei?^ • Jen + (fc/e/ - AR)ei. 

From (14 1, we have ej — C2eR + en- Substituting this and 



( 37 I, the above equation becomes 

V2 = -fcn||en|P + C2e_R • Jen 

- C2kR\\eB,\\'^ + C2eR ■ {{Jen + d)^en - fcnen)- 

Since ||e/j|| < 1, WcrW < ||en||, and ||rf|| < B2, we have 

V2 <~Z^W2Z2, (42) 

where the matrix W2 E M^^^ is given by 



W, 



C2kR -'f{kn + B2) 

-f{kn + B2) kn-2c2XM _ 



The condition on C2 given at (fT6]l guarantees that all of 
matrices M21, W2 are positive definite. This implies that the 
zero equilibrium of tracking errors {en, eji, e/) — (0, 0, ^) 
is stable in the sense of Lyapunov, and eu,efi -^ as 
t —> 00. But, this does not necessarily implies R -^ Rd as 
en — at any critical point of ^ described at the property 
(iii) of Proposition [T] 

Instead, we show instability of undesired equilibrium. 
Define W2 = 'ikji - V2. Then yV2 = at the undesired 
equilibria as $ = 2 at those points. Since 



>V2> 



|en|l' + fci?(2-*)-C2||efl||||eo|| 



ki 



A 



ei 



Ru2 



ki 



Due to the continuity of ^I*, at any arbitrary small neighbor- 
hood of the undesired equilibrium attitude, we can choose 
R such that 2 - * > 0. Therefore, if ||en|| and ||e/ - f^|| 
are sufficiently small, then yV2 > at such attitudes. In 
short, at any arbitrary small neighborhood of the undesired 
equilibrium, there exists a domain where W2 > 0, and 
yV2 = — V2 > in that domain from (42 1. According to 



Theorem 4.3 at [24], the undesired equilibrium is unstable. 

The region of attraction to the desired equilibrium ex- 
cludes the stable manifolds to the undesired equilibria. But 
the dimension of the union of the stable manifolds to the 
unstable equilibria is less than the tangent bundle of SO (3). 
Therefore, the measure of the stable manifolds to the unstable 
equilibrium is zero. Then, the desired equilibrium is referred 
to as almost globally asymptotically stable with respect to 
e_R and en. 

If this Lyapunov analysis is restricted to the domain D2, 



then the upper-bound of ( 39 1 is satisfied, and the condition on 
C2 guarantees that the matrix A/22 is positive definite. These 
yield local exponential stability with respect to eji and en- 

B. Proof of Proposition p] 

We first derive the tracking error dynamics and a Lyapunov 
function for the translational dynamics of a quadrotor UAV, 
and later it is combined with the stability analyses of the 
rotational dynamics in Appendix [A] 

The subsequent analyses are developed in the domain Di 

Di = {(e^, e„, i?, en) G M^ x M^ x S0(3) x M^ | 

l|e:r|| <e:,„_, * < ?Al <1}, (43) 

Similar to ( fTT) , we can show that 

|2 



lM'<nR,R^)<j^^ 



eflll 



(44) 



a) Translational Error Dynamics: The time derivative 
of the position error is ex = ey. The time-derivative of the 
velocity error is given by 

mey — mx — niXd — rnge^ — fRe^ — mxd + A^- (45) 

Consider the quantity e^R^Re^, which represents the cosine 
of the angle between 63 = Re^ and 63^ = Rce^. Since 
1 — ^i/(-R, Re) represents the cosine of the eigen-axis rotation 



angle between R^ and R, we have e^R^Rer^ > 1 
'^{R,Rc) > in L»i. Therefore, the quantity 



well-defined. To rewrite the error dynamics of e„ in terms 
of the attitude error e^, we add and subtract tJtr — -^063 



to the right hand side of ( 45 1 to obtain 

/ 



e^RTRes^ 



mey — mge^ — mxd 



:RTRe3 



Rce3~X + Ax, (46) 



•^ i{e^R^Re3)Re3 - R^e^). (47) 



elR^^Re^ 



where X e M^ is defined by 
X^ - 

Let A — —k^ex — kyCy — fciSato-(ei) — mge^ + mxd- Then, 
from (|20]l, (|25]), we have 63^ = i?ce3 = -A/ \\A\\ and / = 
—A ■ Re^. By combining these, we obtain / — {\\A\\ Rce^) ■ 
Rej,. Therefore, the third term of the right hand side of ( |46] ) 
can be written as 

/ „ (||A||i?ee3)-i?e3 _^ 

PI 



3^RjRe: 



-RcSs 



A 



ejRjRea 

kyey — kiSata-iei) — mge^ + mXd- 



Substituting this into (46 1, the error dynamics of e„ can be 
written as 



mey 



'kx^x kyey KiSat(j(eij A + A^ 



(48) 



b) Lyapunov Candidate for Translation Dynamics: Let 
a Lyapunov candidate Vi be 



Vi = -kx\\ex 



1 



TO||e„|| 



ciex ■ mey 



+ / (kisatcrifj-) ~ Ax) ■ d^. 



(49) 



The condition given at ( [29] l implies that the last integral term 
of the above equation is positive definite about e^ = ^. The 



derivative of Vi along the solution of (48 1 is given by 

Vi = -{ky - mci)||e„|p - cikx\\ex\\^ - cikyex ■ e„ 

+ X ■ {c^ex + ey} . (50) 



The last term of the above equation corresponds to the 
effects of the attitude tracking error on the translational 



dynamics. We find a bound of X, defined at (47 1, to show 
stability of the coupled translational dynamics and rotational 
dynamics in the subsequent Lyapunov analysis. Since / = 

\\A\\{eJ R'J^ Re^), we have 

\\X\\ <\\A\\\\{ejR^Re3)Re3-Ree3\\ 

< {kxWexW + ky\\ey\\ + Viha + Bi) 
X \\{ejRjRe3)Re3-Rce3\\. 

The last term \\{e^ R'J^ Re3)Re3 — RcC^W represents the sine 
of the angle between 63 = Re^ and bc^^ = Rc^s, since 
(^3c • ^3)^3 ~ ^3e = bs X (63 X 63^). The magnitude of the 
attitude error vector, \\enW represents the sine of the eigen- 
axis rotation angle between Re and R (see [23]). Therefore, 
\\{ejR'^Re3)Re3 - RcesW < ||efl,|| in Di. It follows that 

\\ielR'SRe3)Re3~Rde3\\ < WcrW = v/*(2 - *) 



<{yVi(2-Vi)=«} 
Therefore, X is bounded by 



< 1. 



Il^ll < (fc.||e,|| + fc,||e„|| + Viha + Bi)\\eii\\ 
< ikx\\ex\\ + ky\\ev\\ + VSha + Bi)a. 



(51) 



(52) 



Substituting (|52]l into pQ\ , 

Vi < -(fc„(l - a) - mci)||e„||^ - Cik^il - a)||ea;||^ 
+ ciky{l + a)\\ex\\\\ey\\ 

+ |lefl|l{(y3fc,a + Bi)(ci||e,|l + ||e„||) + A:,||e,||||e,||} 

(53) 

In the above expression for Vi, there is a third-order error 
term, namely fc2:||e7v,||||ea;||||e„||. Using (51 1, it is possible 
to choose its upper bound as fca;Q:||ea;||||e„|| similar to other 
terms, but the corresponding stability analysis becomes com- 
plicated, and the initial attitude error should be reduced 
further Instead, we restrict our analysis to the domain 
Di defined in ( |43] ), and its upper bound is chosen as 
kxex„,^JeR\\\\ey\\. 

c) Lyapunov Candidate for the Complete System: Let 
V = Vi + V2 be the Lyapunov candidate of the complete 
system. Define zi = [||e2;||, \\ey\\Y , zi = [||efl||, ||en||]^ G 
M^, and 



Vi = h 



kj 
(sat^(^) - Aj;) • d^i + ylle/ 



ki " ■ 



Using (44 1, the bound of the Lyapunov candidate V can be 
written as 

z^MiiZi + ZIM21Z2 + Vi <V 

< zf M12Z1 + zJM^2Z2 + Vi, (54) 
where the matrices Mn, M12, M21, M22 are given by 



Mil 

M21 = 



mci 
m 



1 kx 

2 —mci 

fcfl, -C2\m 
-C2XM 



M 



An 



12 



M'22 



mci 

r 2kn 

2-Vl 
M 



mci 
m 



C2A 



C2A 



M 



Using (42 1 and (53 1, the time-derivative of V is given by 

V < -zfWiZi + zJWi2Z2 - zJW2Z2 < -z^Wz (55) 



where z = [zi, 22]"^ G I^^. and the matrices Wi,Wi2,W2 € 
]R2x2 are defined at ([32|-([34|. The matrix W G M2x2 j^ 
given by 



W 



XmiWi) -i||T4^12||2 



-h\m 



2||2 



Xrn{W2) 



The conditions given at (I61, (30i, ( [3T| guarantee that all 
of matrices A/n, Af2i, M21, M22, W^ are positive definite, 
and ([29| implies that the integral term of Vi at ([49| is 



positive definite about e^ = ^. This implies that the zero 
equilibrium of the tracking error is exponentially stable with 
respect to ex,ev,eR,eQ, and the integral terms ei,ei are 
uniformly bounded. 



C Proof of Proposition p] 

According to the proof of Proposition [2] the attitude track- 
ing errors asymptotically decrease to zero, and therefore, 
they enter the region given by ( [27]i in a finite time t*, after 
which the results of Proposition^] can be applied to yield 
attractiveness. The remaining part of the proof is showing 
that the tracking error zi = [||ea;||, ||e^||]^ is bounded in 
t e [0,i*]. This is similar to the proof given at [25], [26]. 
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